/*****************************************************************************
 * Copyright (c) 2019 FrontISTR Commons
 * This software is released under the MIT License, see LICENSE.txt
 *****************************************************************************/

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <assert.h>

#include "hecmw_common_define.h"
#include "hecmw_struct.h"
#include "hecmw_malloc.h"

#include "hecmw_couple_define.h"
#include "hecmw_couple_boundary_info.h"
#include "hecmw_couple_weight.h"
#include "hecmw_couple_n2s_with_area.h"

#define FRAC_1_2 (0.5)

#define FRAC_1_3 (0.33333333333333333)

#define FRAC_1_4 (0.25)

/*================================================================================================*/

struct link_list {
  int id;
  double weight;
  struct link_list *next;
};

struct hecmw_couple_vertex {
  double x;
  double y;
  double z;
};

struct hecmw_couple_vector {
  double x;
  double y;
  double z;
};

/*================================================================================================*/

static void free_link_list(struct link_list *r) {
  struct link_list *p, *q;

  for (p = r; p; p = q) {
    q = p->next;
    HECMW_free(p);
  }
}

static void cross_product(struct hecmw_couple_vertex *coord0,
                          struct hecmw_couple_vertex *coord1,
                          struct hecmw_couple_vertex *coord2,
                          struct hecmw_couple_vector *cross_prod) {
  cross_prod->x = (coord1->y - coord0->y) * (coord2->z - coord0->z) -
                  (coord1->z - coord0->z) * (coord2->y - coord0->y);
  cross_prod->y = (coord1->z - coord0->z) * (coord2->x - coord0->x) -
                  (coord1->x - coord0->x) * (coord2->z - coord0->z);
  cross_prod->z = (coord1->x - coord0->x) * (coord2->y - coord0->y) -
                  (coord1->y - coord0->y) * (coord2->x - coord0->x);
}

static double tri_area(struct hecmw_couple_vector *cross_prod) {
  return sqrt(cross_prod->x * cross_prod->x + cross_prod->y * cross_prod->y +
              cross_prod->z * cross_prod->z) *
         FRAC_1_2;
}

static double quad_area(struct hecmw_couple_vector *cross_prod1,
                        struct hecmw_couple_vector *cross_prod2) {
  return tri_area(cross_prod1) + tri_area(cross_prod2);
}

static int n2s_with_area_tet1(const struct hecmwST_local_mesh *mesh,
                              const struct hecmw_couple_boundary *boundary,
                              int id, struct link_list *weight_list) {
  struct hecmw_couple_vertex coord[3];
  struct hecmw_couple_vector cross_prod;
  struct link_list *p;
  double area;
  int node_id[3], node, n, i;

  for (n = 0, i = boundary->elem_node_index[id];
       i < boundary->elem_node_index[id + 1]; i++) {
    node_id[n] = boundary->elem_node_item[i];
    node       = boundary->node->item[node_id[n]];
    coord[n].x = mesh->node[3 * (node - 1)];
    coord[n].y = mesh->node[3 * (node - 1) + 1];
    coord[n].z = mesh->node[3 * (node - 1) + 2];
    n++;
  }
  cross_product(&coord[0], &coord[1], &coord[2], &cross_prod);
  area = tri_area(&cross_prod);

  for (i = 0; i < 3; i++) {
    p = (struct link_list *)HECMW_malloc(sizeof(struct link_list));
    if (p == NULL) {
      HECMW_set_error(errno, "");
      return -1;
    }
    p->id                = node_id[i];
    p->weight            = 1.0 / (3.0 * area);
    p->next              = weight_list[i].next;
    weight_list[id].next = p;
  }

  return 0;
}

static int n2s_with_area_hex1(const struct hecmwST_local_mesh *mesh,
                              const struct hecmw_couple_boundary *boundary,
                              int id, struct link_list *weight_list) {
  struct hecmw_couple_vertex coord[4];
  struct hecmw_couple_vector cross_prod1, cross_prod2;
  struct link_list *p;
  double area;
  int node_id[4], node, n, i;

  for (n = 0, i = boundary->elem_node_index[id];
       i < boundary->elem_node_index[id + 1]; i++) {
    node_id[n] = boundary->elem_node_item[i];
    node       = boundary->node->item[node_id[n]];
    coord[n].x = mesh->node[3 * (node - 1)];
    coord[n].y = mesh->node[3 * (node - 1) + 1];
    coord[n].z = mesh->node[3 * (node - 1) + 2];
    n++;
  }
  cross_product(&coord[0], &coord[1], &coord[3], &cross_prod1);
  cross_product(&coord[2], &coord[3], &coord[1], &cross_prod2);
  area = quad_area(&cross_prod1, &cross_prod2);

  for (i = 0; i < 4; i++) {
    p = (struct link_list *)HECMW_malloc(sizeof(struct link_list));
    if (p == NULL) {
      HECMW_set_error(errno, "");
      return -1;
    }
    p->id                = node_id[i];
    p->weight            = 1.0 / (4.0 * area);
    p->next              = weight_list[id].next;
    weight_list[id].next = p;
  }

  return 0;
}

static int n2s_with_area(const struct hecmwST_local_mesh *mesh,
                         const struct hecmw_couple_boundary *boundary,
                         struct hecmw_couple_weight *weight_info) {
  struct link_list *weight_list = NULL, *p;
  int elem, n_item, size, n, i;

  size        = sizeof(struct link_list) * boundary->surf->n;
  weight_list = (struct link_list *)HECMW_malloc(size);
  if (weight_list == NULL) {
    HECMW_set_error(errno, "");
    goto error;
  }
  for (i = 0; i < boundary->surf->n; i++) {
    weight_list[i].id     = -1;
    weight_list[i].weight = 0.0;
    weight_list[i].next   = NULL;
  }

  /*
   * calculate weight
   */

  for (i = 0; i < boundary->surf->n; i++) {
    elem = boundary->surf->item[2 * i];

    if (mesh->elem_type[elem - 1] == HECMW_ETYPE_TET1) {
      if (n2s_with_area_tet1(mesh, boundary, i, weight_list) != HECMW_SUCCESS)
        goto error;
    } else if (mesh->elem_type[elem - 1] == HECMW_ETYPE_HEX1) {
      if (n2s_with_area_hex1(mesh, boundary, i, weight_list) != HECMW_SUCCESS)
        goto error;
    } else {
      HECMW_set_error(HECMWCPL_E_NONSUPPORT_ETYPE, "");
      goto error;
    }
  }

  /*
   * make interpolating information
   */
  /* number of surfaces */
  weight_info->n = boundary->surf->n;

  /* interpolating type */
  weight_info->type = HECMW_COUPLE_IP_NODE_TO_SURF;

  /* index of list */
  weight_info->index = (int *)HECMW_calloc(weight_info->n + 1, sizeof(int));
  if (weight_info->index == NULL) {
    HECMW_set_error(errno, "");
    goto error;
  }
  for (n = 0, i = 0; i < boundary->surf->n; i++) {
    for (p = weight_list[i].next; p; p = p->next) {
      n++;
    }
    weight_info->index[i + 1] = n;
  }

  /* id & weight */
  n_item          = weight_info->index[weight_info->n];
  weight_info->id = (int *)HECMW_malloc(sizeof(int) * n_item);
  if (weight_info->id == NULL) {
    HECMW_set_error(errno, "");
    goto error;
  }
  weight_info->weight = (double *)HECMW_malloc(sizeof(double) * n_item);
  if (weight_info->weight == NULL) {
    HECMW_set_error(errno, "");
    goto error;
  }
  for (n = 0, i = 0; i < boundary->surf->n; i++) {
    for (p = weight_list[i].next; p; p = p->next) {
      weight_info->id[n]     = p->id;
      weight_info->weight[n] = p->weight;
      n++;
    }
  }

  /*
   * free linked list
   */
  for (i = 0; i < boundary->surf->n; i++) {
    free_link_list(weight_list[i].next);
  }
  HECMW_free(weight_list);

  return 0;

error:
  for (i = 0; i < boundary->surf->n; i++) {
    free_link_list(weight_list[i].next);
  }
  HECMW_free(weight_list);
  return -1;
}

extern struct hecmw_couple_weight_list *HECMW_couple_n2s_with_area(
    const struct hecmwST_local_mesh *mesh,
    const struct hecmw_couple_boundary *boundary) {
  struct hecmw_couple_weight_list *weight_info_list = NULL;
  struct hecmw_couple_weight *weight_info           = NULL;

  if (mesh == NULL) {
    HECMW_set_error(HECMWCPL_E_INVALID_ARG,
                    "HECMW_couple_n2s_with_area(): 'mesh' is NULL");
    return NULL;
  }
  if (boundary == NULL) {
    HECMW_set_error(HECMWCPL_E_INVALID_ARG,
                    "HECMW_couple_n2s_with_area(): 'boundary' is NULL");
    return NULL;
  }

  if ((weight_info_list = HECMW_couple_alloc_weight_list()) == NULL)
    return NULL;

  if ((weight_info = HECMW_couple_alloc_weight()) == NULL) return NULL;
  weight_info_list->info = weight_info;

  if (n2s_with_area(mesh, boundary, weight_info)) goto error;

  return weight_info_list;

error:
  HECMW_couple_free_weight(weight_info);
  weight_info_list->info = NULL;
  HECMW_couple_free_weight_list(weight_info_list);
  return NULL;
}
